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FOREWORD 


The  mathematical  model  and  alignment  algorithm  discussed  in  this  report  were  developed 
by  the  Combat  System  Technologies  Branch  (N35)  of  the  Engineering  and  Technology  Division 
(N30)  and  the  Weapons  Direction  Systems  Branch  (G71)  of  the  Weapons  Control  Division 
(G70).  This  work  was  funded  by  the  Independent  Research  Program  at  the  Naval  Surface 
Warfare  Center  Dahlgren  Division  (NSWCDD).  This  report  has  been  reviewed  at  NSWCDD  in 
the  Engineering  and  Technology  Division  and  the  Weapons  Control  Division. 
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ABSTRACT 


The  problem  of  aligning  two  sensors  using  targets  of  opportunity  is  examined  in  this  report, 
where  one  of  the  sensors  is  a  3-D  sensor  that  measures  range,  azimuth,  and  elevation  and  the 
other  one  is  a  2-D  sensor  that  measures  azimuth  and  elevation.  Both  a  mathematical  model  and 
an  alignment  algorithm  are  developed  for  this  problem,  where  attitude  and  offset  errors  in  both 
sensors  are  included  in  the  formulation.  Because  of  the  method  used  to  formulate  the  problem,  it 
is  not  possible  to  determine  the  individual  alignment  errors  at  each  sensor.  However,  it  is 
possible  to  determine  the  differences  in  the  respective  alignment  errors  of  the  two  sensors.  This 
is  sufficient  to  align  one  sensor  relative  to  the  other  one.  For  illustrative  purposes,  the  alignment 
algorithm  is  applied  to  simulated  data  from  two  sensors.  The  algorithm  converges  within  50  sec 
to  values  veiy  close  to  the  actual  values  of  the  alignment  parameters.  Using  tiiese  values,  it  is 
possible  to  obtain  a  dramatic  23-fold  reduction  in  the  relative  error  between  the  tracks  generated 
by  the  sensors. 
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1.0  INTRODUCTION 


In  recent  years,  interest  in  integrating  stand-alone  sensors  into  multisensor  systems  has  been 
increasing.  The  reasons  for  this  interest  include  the  potential  for  improvement  of  system 
performance  and  enhanced  system  capabilities.  To  effectively  share  the  data  between  the 
sensors  in  the  systems,  all  of  the  sensors  must  be  accurately  aligned.  This  is  particularly 
important  if  the  data  from  the  sensors  are  to  be  fused.  The  presence  of  alignment  errors  will 
degrade  the  overall  system  performance  and  may  lead  to  system  performance  that  is  worse  than 
the  performance  of  the  individual  sensors  in  the  system.  The  alignment  procedure  must  correct 
the  effects  of  the  alignment  errors  on  the  multisensor  data. 

The  alignment  of  the  sensors  on  a  ship  is  usually  performed  when  the  ship  is  undergoing 
dockside  maintenance.  At  that  time,  they  are  aligned  with  respect  to  some  stationary  point. 
Typically,  this  is  the  only  time  that  the  sensors  are  aligned.  Once  the  ship  returns  to  duty  and 
puts  out  to  sea,  there  is  no  way  of  checking  the  alignment  of  the  sensors.  If  the  errors  in  the 
alignment  of  each  sensor  fluctuate  only  a  small  amount  during  the  ship’s  time  at  sea,  there  is 
little  reason  to  worry  about  alignment  errors.  This  is  especially  true  when  the  data  from  the 
various  sensors  are  not  integrated.  However,  with  the  advent  of  sensors  having  greater 
accuracies  and  the  desire  to  fuse  the  data  from  several  sensors  to  obtain  more  accurate  and 
reliable  tracks,  it  is  now  necessary  to  be  able  to  check  the  accuracy  of  the  alignment  of  the 
sensors  throughout  the  period  of  time  the  ship  is  at  sea.  For  example,  two  sensors  whose  data 
might  be  fused  are  a  3-D  radar  that  measures  range,  azimuth,  and  elevation  and  a  2-D  sensor  that 
measures  azimuth  and  elevation  (e.g.,  an  infrared  (IR)  sensor).  Here,  the  IR  sensor  might  have 
angular  accuracies  of  less  than  a  milliradian  and  the  radar  will  measure  a  relatively  accurate 
range,  something  the  IR  sensor  does  not  measure.  Sensor  alignment  is  also  required  when 
integrating  data  from  land-based  sensors.  The  problem  of  sensor  misalignment  in  a  system  of 
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land-based  sensors  has  been  documented  with  real  data  collected  during  the  North  Atlantic 
Treaty  Organization  (NATO)  Antiair  Warfare  (AAW)  experiments.^ 

One  source  of  alignment  errors  is  sensor  calibration  errors  (i.e.,  offsets).  Although  the 
sensors  are  usually  calibrated  in  an  initial  calibration  procedure,  the  calibration  may  deteriorate 
over  time.  Another  source  of  alignment  errors  is  attitude  errors  between  the  sensor’s  reference 
frame  and  its  stabilized  frame.  One  source  of  these  attitude  errors  is  flexure  in  the  platform  on 
which  the  sensors  are  located.^  In  shipboard  applications,  the  action  of  waves  on  a  ship,  the 
amount  of  loading  on  a  ship,  and  the  motion  of  a  ship  can  all  cause  the  ship’s  structure  to  flex. 
This  flexing  will  cause  the  sensor’s  reference  frame  to  become  misaligned  with  respect  to  the 
ship’s  stabilized  frame.  The  magnitude  of  this  misalignment  will  depend  on  the  location  of  the 
sensor  on  the  ship;  and  because  the  various  sensors  are  usually  located  at  different  places  on  the 
ship,  the  misalignment  due  to  flexing  will  be  different  for  each  sensor.  Platform  flexure  will  also 
be  a  problem  for  sensors  located  on  an  aircraft. 

Some  work  has  been  done  on  the  removal  of  alignment  errors  in  multisensor  systems 
consisting  of  3-D  sensors.^*^’^’®  One  problem  that  has  received  little  attention  is  the  removal  of 
alignment  errors  in  dissimilar  sensors  (e.g.,  active  and  passive  sensors,  2-D  and  3-D  sensors, 
etc,).  However,  the  alignment  of  dissimilar  sensors  is  important  in  applications.  For  example, 
this  alignment  problem  occurs  in  the  integration  of  a  2-D  radar  to  a  3-D  radar  and  in  the 
integration  of  an  optical  sensor  to  a  radar.  The  problem  of  aligning  two  sensors  using  targets  of 
opportunity  is  examined  in  this  report,  where  one  of  the  sensors  is  a  3-D  sensor  that  measures 
range,  azimuth,  and  elevation  and  the  other  one  is  a  2-D  sensor  that  measures  azimuth  and 
elevation.  It  will  be  assumed  that  the  sensors  are  close  to  each  other,  as  would  occur  for  sensors 
located  on  the  same  platform,  and  the  alignment  errors  do  not  change  with  time  (i.e.,  static 
alignment  problem). 

This  report  is  organized  in  the  following  manner;  In  Section  2,  a  mathematical  model  is 
developed  for  this  alignment  problem.  Kalman  filtering  techniques  are  applied  to  this  model  in 
Section  3  to  obtain  the  alignment  algorithm;  and  this  algorithm  is  tested  with  simulated  data  in 
Section  4.  Finally,  Section  5  summarizes  the  results  of  this  study. 
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2.0  MATHEMATICAL  DEVELOPMENT 


The  problem  addressed  in  this  report  can  be  stated  as  follows:  Given  the  measurements 
from  two  sensors  (range,  elevation,  and  azimuth  from  the  3-D  sensor  and  elevation  and  azimuth 
from  the  2-D  sensor)  over  time  for  a  specific  target,  estimate  the  parameters  that  will  align  the 
data  from  the  2-D  sensor  to  the  data  from  the  3-D  sensor.  Several  assumptions  will  be  employed 
in  dealing  with  this  problem.  Specifically,  the  assumptions  are  as  follows: 

1.  The  distance  between  the  sensors  is  small  (<  100  m). 

2.  Any  location  errors  in  the  relative  positions  of  the  sensors  are  negligible. 

3.  The  magnitudes  of  the  alignment  errors  are  small. 

4.  The  sensors  provide  the  measurement  data  at  the  same  rates,  and  the  data  from  the 
sensors  are  coincident  in  time. 

The  first  assumption  is  consistent  with  sensors  located  on  a  single  platform,  and  it  will 
allow  us  to  use  the  flat-Earth  approximation  in  the  transformation  of  data  between  the  sensors. 
The  second  assumption  is  also  consistent  with  sensors  located  on  a  single  plaform.  Errors  in  the 
relative  locations  of  sensors  on  a  single  platform  are  negligible  because  the  distances  between 
the  sensors  can  be  accurately  surveyed  in  an  initial  calibration  procedure.  Errors  in  the 
translation  vector  between  the  sensor’s  frames  could  occur  because  of  platform  flexure.  This 
will  introduce,  at  most,  a  difference  in  distance  of  several  meters  from  the  surveyed  distance 
between  the  sensors.  This  error  in  distance  between  the  sensors  will  produce  a  small  relative 
error  in  the  data  when  the  data  are  transformed  between  the  sensors.  The  small  error  in  the 
distance  between  the  sensors  will  be  ignored  because  of  its  small  effect  on  the  data.  Of  course, 
this  flexing  will  produce  a  change  in  the  direction  of  the  translation  vector  between  the  sensors 
which,  in  turn,  will  introduce  errors  in  the  relative  orientation  of  the  sensor’s  frames.  These 
orientation  errors  will  be  modeled.  The  third  assumption  will  allow  us  to  employ  a  first-order 
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Taylor  series  approximation,  and  it  will  result  in  a  linearized  version  of  the  alignment  problem. 
Finally,  the  last  assumption  is  made  for  convenience  in  developing  the  theory.  This  last 
assumption  will  not  hold  in  practice.  The  data  from  the  various  sensors  are  not  coincident  in 
time,  and  they  must  be  extrapolated  to  a  common  point  of  time.  Also,  the  data  rates  from  the 
various  sensore  are  usually  different.  These  two  important  factors  will  not  be  addressed  in  this 
report. 

2.1  ATTITUDE  ERRORS 


Consider  a  particular  sensor,  say  the  sensor,  where  k  =  1,2.  A  reference  frame  is 
necessary  in  describing  the  sensor’s  measurements.  The  reference  frame  in  which  this 
sensor’s  measurements  are  made  will  be  called  the  sensor’s  measurement  frame.  There  is  also  a 
stabilized  frame  associated  with  this  sensor.  The  stabilized  frame  is  aligned  to  the  true  north- 
south  horizontal  line,  the  true  east-west  horizontal  line,  and  the  axis  that  is  orthogonal  to  the 
horizontal  plane  formed  by  the  north-south  and  east-west  lines.  Because  of  attitude  (or 
orientation)  alignment  errors  (e.g.,  from  platform  flexure),  the  measurement  frame  may  not  be 
aligned  to  the  stabilized  frame.  Both  frames  have  the  same  origin,  but  one  frame  is  tilted  with 
respect  to  the  other  one. 

The  stabilized  frame  at  the  kf^  sensor  can  be  represented  by  the  three  mutually  orthogonal 
unit  vectors  and  The  subscript  k  denotes  the  sensor,  and  the  subscripts  x',  y', 

and  z'  refer  to  the  directions  of  north,  east,  and  up,  respectively.  Similarly,  the  measurement 
frame  at  the  kf^  sensor  can  be  represented  by  the  three  mutually  orthogonal  unit  vectors  Cy^ 
ande^. 

Let  the  spherical  coordinates  of  a  point  in  the  k^^  sensor’s  stabilized  frame  be  denoted  by 
r'^,  0'^,  and  c'^,  which  represent  the  range,  azimuth,  and  elevation  of  the  point,  respectively.  The 
position  vector  for  this  point  expressed  in  rectangular  coordinates  in  the  kf^  sensor’s  stabilized 
frame  will  be  denoted  by  r'^,  where  r'^  =  [  x'^  y'^  z\  is  the  3  x  1  column  vector  (the 
superscript  T  denotes  matrix  transposition)  with  the  rectangular  coordinates 

x'^  =  f i^cost\sinQ'i^,  y'^  =  r'^  co5  e'^  coj  0'^ ,  =  T'i^sint\.  (2-1) 
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Similarly,  the  spherical  coordinates  of  this  point  in  the  sensor’s  measurement  frame  are 
denoted  by  r^^  0^,  and  and  yj^  is  the  position  vector  in  the  sensor’s 

measurement  frame,  where 

Xj^  =  Tf^costj^sinQi^,  y^^  =  r^  cos  c<?5  0^ ,  =  Ti^sintj^.  (2-2) 

The  transformation  between  the  sensor’s  stabilized  frame*  and  measurement  frame  can 
be  described  by  a  set  of  Eulerian  angles.  The  xyz-convention^  will  be  employed  in  this  report. 
In  the  xyz-convention,  the  first  rotation  is  the  yaw  angle  <|>^  about  the  stabilized  frame’s  z-axis, 
the  second  rotation  is  the  pitch  angle  about  the  intermediate  y-axis,  and  the  third  rotation  is 
the  roll  angle  about  the  final  x-axis.  The  transformation  of  the  position  vector  from  the  kf^ 
sensor’s  stabilized  frame  to  its  measurement  frame  is  given  by 

r„  =  (2-3) 

where  is  the  3  x  3  orthogonal  matrix  given  by^ 

cosr\i^cos^l^  cosT\j^sin^l^ 

Aj^  =  sin  \fj^sinr\j^cos^i^-  cos  ^  sin^|^sin^|^  +  cos  cos 

cos  sin  cos  +  sin  sin  cos  sin  sin  -  sin  y^  cos 

.  -1  T 

Since  A^  is  an  orthogonal  matrix,  A^  =  A^,  and  the  transformation  from  the  measurement  frame 
to  the  stabilized  frame  is  given  by 

r-*  =  R,r„  (2-5) 

T 

where  R^  =  A^. 

To  be  specific,  let  the  first  sensor  (fc  =  1)  be  the  3-D  sensor,  and  the  second  sensor  {k  =  2) 
the  2-D  sensor.  Let  the  2-D  sensor  be  located  at  the  point  t  =  [  t^  ty  t^  in  the  3-D  sensor’s 
stabilized  frame.  The  vector  t  is  assumed  to  be  known.  For  example,  t  can  be  accurately 
determined  in  an  initial  calibration  procedure. 

The  transformation  from  the  3-D  sensor’s  stabilized  frame  to  the  2-D  sensor’s  stabilized 
frame  is  given  by 


-jirni* 

cos  11;^  sin  yj^  .  (2-4) 

cos  Tijt  cos  y^ 
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r'21  =  r'l  -  t.  (2-6) 

;re  r'j  is  a  position  vector  in  the  3-D  sensor’s  stabilized  frame,  and  r'21  is  the  corresponding 
ition  vector  in  the  2-D  sensor’s  stabilized  frame.  Using  Equation  2-5  in  Equation  2-6  gives 

**21  “  ~  (2-7) 

;re  T}  and  r2i  are  the  corresponding  position  vectors  in  the  3-D  and  2-D  sensor’s 
isurement  frames,  respectively.  Since  R2  is  an  orthogonal  matrix.  Equation  2-7  can  be 
iressed  as 

*"21  ~  ^  **1  —  ®^2  (2-8) 

ere 

R  =  RjRj.  (2-9) 

nation  2-8  represents  the  transformation  from  the  3-D  sensor’s  measurement  frame  to  the  2-D 
isor’s  measurement  frame,  and  it  accounts  for  the  attitude  alignment  errors  in  both  sensors. 

Assuming  that  the  yaw,  pitch,  and  roll  angles  at  each  sensor  are  small  (^  1°),  the  small- 
;le  approximations  (i.e.,  first-order  Taylor  series  expansions  about  zero)  can  be  used  in  the 
[onometric  quantities  in  Ri  and  R2.  In  this  case,  R^  (where  k=  1,2)  can  be  approximated  by 
first  order) 

R^  »  I  +  dR*,  (2-10) 

ere  I  is  the  3  x  3  identity  matrix,  and  dR^  is  the  matrix  differential  of  R^  given  by 
0  Tl* 

dR^  =  0  -V*  •  (2-11) 

-Ti*  Vjt  0 

jstituting  these  into  Equation  2-9  allows  the  matrix  R  to  be  approximated  by  (to  first  order) 

R  «  I  +  dR,  (2-12) 
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where 


dR  =  dR,  +  dR^ 


0 

A<|> 

Aq 

A(]> 

0 

A\|/ 

Aq 

-Ay 

0 

(2-13) 


and 

A<|>  =  <|)2-<t>i,  AT)  =  Tii-'n2,  Av  =  V2-Vl-  (2-14) 

Using  these  approximations  in  the  transformation  equation  appearing  in  Equation  2-8  gives 
r2i  =>  Ti  -  t  +  dR  -  dR2  t.  (2-15) 


The  last  term  appearing  on  the  right  side  of  Equation  2-15  is  negligible  under  the 

assumptions  made  for  this  problem.  This  term  accounts  for  the  error  in  the  transformation 

caused  by  the  apparent  rotation  of  the  origin  of  the  3-D  sensor’s  frame  due  to  the  tilting  of  the 

2-D  sensor’s  measurement  frame,  with  respect  to  its  stabilized  frame.  Assuming  that  the 

maximum  value  of  the  roll,  pitch,  and  yaw  at  the  second  sensor  is  1°,  and  the  maximum 

T 

separation  between  the  sensors  is  100  m,  it  can  be  shown  that  ||  dR2  t  H  ^  6  m.  That  is,  ignoring 
the  last  term  on  the  right  side  of  Equation  2-15  will  introduce  no  more  than  6  m  of  error  in  the 
transformation  equation,  and  Equation  2-15  becomes 

r2i  »  Ti  -  t  +  dR  Tj.  (2-16) 

The  transformation  in  Equation  2-16  is  accomplished  by  first  transforming  to  the  2-D  sensor’s 
frame  as  if  there  were  no  alignment  errors  (i.e.,  Tj  - 1).  Then,  the  effects  of  the  attitude  errors  in 
the  sensors  are  accounted  for  by  adding  dR  fj  to  the  previous  result. 

The  attitude  parameter  in  Equation  16  are  the  yaw  parameter  A<p,  the  pitch  parameter  Aq, 
and  the  roll  parameter  Ay,  and  they  are  elements  of  the  matrix  dR.  There  are  only  three  attitude 
parameters  because  the  last  term  on  the  right  side  of  Equation  2-15  was  ignored.  These  attitude 
parameters  depend  only  on  the  differences  in  the  Eulerian  angles  (see  Equation  2-14)  that 
describe  the  orientations  of  the  measurement  frames  of  the  two  sensors.  In  this  sense.  Equation 
2-16  can  be  thought  of  as  the  transformation  that  relatively  aligns  the  3-D  sensor’s  measurement 
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frame  to  the  2-D  sensor’s  measurement  firame.  For  widely  separated  sensors  (e.g.,  sensors 
located  on  separate  platforms),  there  may  be  difficulties  in  the  relative  alignment  of  the  sensor’s 
measurement  frames  because  it  may  not  be  valid  to  ignore  the  last  term  on  the  right  side  of 
Equation  2-15. 

It  is  also  possible  to  relatively  align  the  2-D  sensor’s  measurement  frame  to  the  3-D 
sensor’s  measurement  frame.  Proceeding  in  a  manner  similar  to  the  one  above,  it  can  be  shown 
that  the  transformation  for  this  alignment  is  given  by 

ri2  “  R  ^2  ^”*“2  +  1  +  dR  r2,  (2-17) 

where  r2  is  a  position  vector  in  the  2-D  sensor’s  measurement  frame,  and  T]2  is  the 
corresponding  position  vector  in  the  3-D  sensor’s  measurement  frame. 


2.2  OFFSET  ERRORS 

In  addition  to  the  attitude  errors  in  the  sensor’s  reference  ftames,  the  sensor’s  measurements 
may  also  contain  offset  errors  (or  biases).  The  3-D  sensor  provides  measurements  of  the  range 
rj,  azimuth  0j,  and  elevation  Cj  (all  expressed  in  the  3-D  sensor’s  measurement  frame),  and  the 
2-D  sensor  provides  measurements  of  the  azimuth  62  and  elevation  62  (expressed  in  the  2-D 
sensor’s  measurement  frame).  The  errors  in  the  measurements  will  be  modeled  as  follows:  the 
measured  value  is  equal  to  the  sum  of  the  true  value,  the  offset  error,  and  the  random 
measurement  error. 

For  the  3-D  sensor,  the  measured  values  of  the  range  Tj,  azimuth  0|,  and  elevation  e|  are 
given  by 

**1  ~  ~  017  +  d0j+e0|,  +  d£j  +  e^j ,  (2-18) 

where  r^jt  0|7>  and  are  the  true  values  of  the  range,  azimuth,  and  elevation;  dr^,  d0j,  and  dEj 
are  the  3-D  sensor’s  offset  errors  in  the  range,  azimuth,  and  elevation;  and  e^j,  eQj,  and  e^j  are 
the  random  errors  in  the  3-D  sensor’s  measurements.  The  first-order  Taylor  series  expansion  of 
the  true  position  vector  r|j  in  the  3-D  sensor’s  measurement  frame  about  the  measured  position 
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vector  r  j  in  the  3-D  sensor’s  measurement  frame  is  given  by 

Tit-  »  Tj  -  dr,  -  e,,  (2-19) 

where  the  differential  dr,  and  the  random  error  vector  e,  are  given  by 

dr,  =  f(0,,e,)  dr,  +  g(r,,e,,e,)  dG,  +  h(r,,0,,e,)  de,.  (2-20) 

e,  =  f(0,,e,)  ej,  +  g(r,,0,,e,)  Cg,  +  h(r,,0,,e,)  e^,.  (2-21) 

The  vector- valued  functions  f,  g,  and  h  are  defined  by 

f(0,  e)  =  ^  =  [cose  sin  0  cose  cos  Q  sineY  ~  ->  (2-22) 

at  r 

g(r,  0,  e)  =  -T  cose  sin  Q  OP  =  [y  -x  OP,  (2-23) 

0  0 

h(r,  0,  e)  =  =  [-T  sine  sin  Q  -t  sine  cos  Q  rcose]^,  (2-24) 

o  e 

where  r  =  [  x  y  z  is  the  position  vector  containing  the  rectangular  coordinates  of  a  point, 
and  r,  0,  and  e  are  the  corresponding  spherical  coordinates.  In  Equations  2-20  and  2-21,  the 
functions  f,  g,  and  h  are  evaluated  at  the  3-D  sensor’s  measurements  r,,  0,,  and  e,. 

For  the  2-D  sensor,  the  measured  values  of  the  azimuth  02  and  elevation  E2  are  given  by 

02  —  ^2T  ®02  ’  ^  ~  ®e2  ’  (2“25) 

where  ©27  and  e^r  are  the  true  values  of  the  azimuth  and  elevation;  d02  and  d£2  are  the  2-D 
sensor’s  offset  errors  in  azimuth  and  elevation;  and  e02  and  e£2  are  the  random  errors  in  the  2-D 
sensor’s  measurements.  Note  that  there  is  no  equation  relating  r2  to  T2j-  for  the  2-D  sensor 
because  the  2-D  sensor  does  not  measure  the  range  r2.  Below,  it  will  be  shown  how  the  3-D 
sensor’s  range  can  be  assigned  to  the  2-D  sensor’s  measurement  frame. 
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2.3  POSITION  VECTOR  IN  THE  2-D  SENSOR’S  MEASUREMENT  FRAME 


Equation  2-16  can  be  used  to  obtain  the  range  T2  in  the  2-D  sensor’s  measurement  frame. 
Using  Equation  2-12  in  Equation  2-16  allows  Equation  2-16  to  be  expressed  as 

rji  «  Rri  -  t,  (2-26) 

where  fj  is  a  position  vector  in  the  3-D  sensor’s  measurement  frame  and  T2\  is  the  corresponding 
position  vector  in  the  2-D  sensor’s  measurement  frame.  Then 

A\  =  ■‘21 '■21  =  (Hri-0  =  rj  +  -  2r]'R’'t,  (2-27) 

where 

2  T  2  T  2  2  2 

r{  =  rj  Ti ,  =  t*  t  =  t;  +  t;  +  t^.  (2-28) 

The  quantity  T21  is  the  3-D  sensor’s  range  measurement  expressed  in  the  2-D  sensor’s 
measurement  frame.  Assign  T21  to  the  2-D  sensor’s  measurements  (i.e.,  let  T2  =  T21).  Using 
Equation  2-27,  T2  can  be  expressed  as 

^2  =  (r?  +  -  2r]'t  -  2r'}'dR’*’t)‘/2,  (2-29) 


where  Equation  2-12  has  been  used  to  eliminate  R.  In  Equation  2-29,  all  of  the  terms  on  the 
right  side  are  known  except  for  the  last  one.  Assuming  that  rj  is  the  dominant  term  on  the  right 
side  of  Equation  2-29,  the  binomial  expansion  can  be  used  to  approximate  T2  by 


rj’^dR'^l 


(2-30) 


Assuming  that  the  maximum  values  of  the  roll,  pitch,  and  yaw  for  each  sensor  is  1°  and  the 
maximum  separation  between  the  sensors  is  100  m,  it  can  be  shown  that  ||  dR  t  /r^  ||  ^  12  m, 
and  this  is  independent  of  the  value  of  the  range.  That  is,  neglecting  the  last  term  on  the  right 
side  of  Equation  2-30  will  introduce  less  than  12  m  of  error  in  the  range  T2.  Similarly,  if  the 
range  rj  =  1000  m,  then  1  t^/  2r|  1  ^  5  m  (and  decreases  as  r|  increases).  Targets  of  interest  will 
have  rj  ^  1000  m.  These  two  terms  will  be  neglected  in  Equation  2-30,  so  that  T2  is 
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approximated  by 


h  ”  h  - 


(2-31) 


where  all  of  the  terms  on  the  right  side  are  known  quantities.  Now,  the  position  vector  T2  in  the 

2- D  sensor’s  measurement  frame  can  be  calculated  using  the  azimuth  62  and  elevation  €2 
measured  by  the  2-D  sensor,  and  the  range  r2  from  Equation  2-31,  which  is  obtained  from  the 

3- D  sensor’s  measurements. 

The  first-order  Taylor  series  expansion  of  the  true  position  vector  T2x  in  the  2-D  sensor’s 
measurement  frame  about  the  measured  position  vector  r2  in  the  2-D  sensor’s  measurement 
frame  is  given  by 


^27  *  '*2  ~  ^'’2  “  ®2’ 


(2-32) 


where  the  differential  dr2  and  the  random  error  vector  62  are  given  by 

dr2  =  f(02.e2)  ^2  g(r2.®2»®2)  <^®2  b(r2'®2’®2) 

®2  ~  ^(02’®2)  ®r2  g(r2»®2'®2)  ®02  **(*’2’®2’®2)  ®e2  • 


(2-33) 


(2-34) 


In  Equations  2-33  and  2-34,  the  offset  error  dr2  and  random  error  e^  in  the  range  r2  depend  on 
the  offset  and  random  errors  in  the  3-D  sensor.  Using  Equation  2-31,  the  first-order  Taylor 
series  expansion  of  the  true  range  r2j’  about  the  measured  range  r2  is  given  by 


T2j  »  r2  -  dr2  -  e^. 


(2-35) 


where  r2  is  given  by  Equation  2-31,  and  the  offset  error  dr2  and  random  error  ej2  are  given  by 


dr2  =  dri  - 


®i2  “  ®rl 


g^(r|,0i.ei)t  li^(rj,01,ej)t 

- d9i  -  - d£i, 

g^(rj,0j,ej)t  h^(rj,0j,e|)t 

- Fj - 601  71 - 


(2-36) 


(2-37) 
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2.4  ALIGNMENT  EQUATION 

As.  ne  that  both  sensors  are  tracking  a  common  target.  The  3-D  sensor  provides 
measurements  of  the  range  rj^,  azimuth  6^,  and  elevation  for  the  target  (expressed  in  the  3-D 
sensor’s  measurement  frame).  The  target’s  position  vector  in  the  3-D  sensor’s  measurement 
frame  can  be  calculated  using  these  measurements.  Similarly,  the  2-D  sensor  provides 
measurements  of  the  azimuth  62  and  elevation  for  the  target  (expressed  in  the  2-D  sensor’s 
measurement  frame).  Equation  2-31  is  used  to  calculate  the  target’s  range  r2  in  the  2-D  sensor’s 
measurement  frame.  Thus,  the  target’s  position  vector  r2  in  the  2-D  sensor’s  measurement  frame 
can  also  be  calculated. 

Let  j.  denote  the  target’s  true  position  vector  in  the  3-D  sensor’s  measurement  frame  and 
r^j  the  target’s  true  position  vector  in  the  2-D  sensor’s  measurement  frame.  Since  r22-  is  a 
position  vector  in  the  2-D  sensor’s  measurement  frame.  Equation  2-17  can  be  used  to  transform 
r2j-  to  the  3-D  sensor’s  measurement  frame.  That  is, 

t"i27'  “  ^2r  +  t  +  dR*^  r2j>  (2-38) 

where  rj27’  is  the  target’s  true  position  vector  r2x  from  the  2-D  sensor’s  measurement  frame,  but 
expressed  in  the  3-D  sensor’s  measurement  frame.  By  defrnition, 

**17  ~  *’127*  (2-39) 

This  gives 

r  ij-  —  1*22'  +  t  +  dR*^  ^27'  (2-40) 

Using  Equations  2-19  and  2-32  to  eliminate  r|j  and  T2j,  and  only  keeping  first-order  terms, 
gives 

Tj  »  r2  +  t  +  a  +  e,  (2-41) 

where  the  alignment  vector  a  and  the  random  error  vector  e  are  given  by 

a  =  dfj  -  dr2  +  dR^r2,  e  =  ej  -  €2-  (2-42) 
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Equation  2-41  is  the  transformation  that  aligns  the  position  vector  r2  from  the  2-D  sensor’s 
measurement  frame  to  the  position  vector  Tj  in  the  3-D  sensor’s  measurement  frame.  Thus, 
Equation  2-41  represents  the  alignment  relative  to  the  3-D  sensor’s  measurement  frame.  The 
alignment  is  accomplished  by  first  transforming  r2  to  the  3-D  sensor’s  frame  as  if  there  were  no 
alignment  errors  (i.e.,  r2  +  t).  This  result  is  then  aligned  to  by  applying  a.  The  term  e 
represents  the  random  errors  in  the  alignment  process. 

Equation  2-41  can  also  be  manipulated  to  obtain  the  alignment  relative  to  the  2-D  sensor’s 
measmement  frame.  This  is  accomplished  by  solving  Equation  2-42  for  r2,  which  gives 

r2  =  Ti  “  t  -  a  -  e.  (2-43) 

In  Equation  2-43,  from  the  3-D  sensor’s  measurement  frame  is  aligned  to  r2  in  the  2-D 
sensor’s  measurement  frame.  Note  that  this  alignment  requires  the  same  information  as  the 
alignment  relative  to  the  3-D  sensor’s  measurement  frame.  In  both  cases,  it  is  necessary  to 
determine  the  alignment  vector  a.  Thus,  it  is  arbitrary  as  to  which  sensor  is  chosen  as  the  master 
sensor. 

The  problem  is  to  find  the  alignment  vector  a.  Using  Equations  2-13,  2-20,  and  2-33  in 
Equation  2-42,  and  Equation  2-36  to  eliminate  dr2,  the  alignment  vector  a  can  be  expressed  as 

a  =  [  f(0i,ei)  -  f(02,e2)  ]  dTj  +  [  g(ri,0j,e,)-i-!il^^^f(02,E2)  ]  d0i 

+  [  b(r2,0j,6|) - p- - f(02,e2)  ]  d£j  —  g(r2,02»E2^  (d02  +  A(J)) 

-  h(r2,02,e2)  de2  +  CjAti  +  C2A\|;,  (2-44) 

where 

Cl  =  [-Z2  0  C2  =  [O  -Z2  y2F.  (2-45) 

In  a  similar  manner,  the  random  error  vector  e  can  be  expressed  as 
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r  T  r  g^fri-Qi-ei)  t 

e  =  [f(ei.ei)-f(02,e2)]eji  +  [g(ri,ei,ei) - - - f(02*e2)]®0i 

+  [  h(rj,0j,ej) - pj - f(02»E2)  J  ®el  “  gfr2»®2'^)  ®02 

-  h(r2,02,e2)  e£2.  (2-46) 

Equations  2-44  and  2-46  can  be  simplified  by  using  the  assumptions  made  for  this  problem. 
It  can  be  shown  that 

||(gT(rj.0i.ei)t/ri)f(02,e2)  d0il|  £  |lt|||d0il.  (2-47) 

II  ( hT(ri.0i.ei)  t  /ri )  f(02,e2)  dej  ||  ^  ||  1 1|  |d£il .  (2-48) 

Since  ||  1 1|  ^  100  m,  |d0j  |  S  1®,  and  Ide^  |  <  1®,  the  expression  in  Equation  2-47  will  contribute 
less  than  1.75  m  to  the  alignment  vector  a.  Similarly,  the  expression  in  Equation  2-48  will  also 

contribute  less  than  1.75  m  to  a.  That  is,  ignoring  both  of  these  terms  will  introduce  an  error  in  a 

of  less  than  3.5  m.  In  this  case.  Equation  2-44  becomes 

a  =  [f(0j,ei)-f(02,e2)]  drj  +  g(ri,0j,ei)  dOj  +  h(rj,0j,e2)  dej 

-  g(r2,02.e2)(d02  +  ^<l*)  ~  h(r2,02,e2)  +  CjAti  +  C2A\jr.  (2-49) 

In  a  similar  manner,  the  random  error  vector  e  can  be  expressed  as 

e  =  [  f(0i,ei)  -  f(02,e2)  ]  e,|  +  g(ri,0i,ei)  egj  +  h(rj,0j,ei)  e^i 

”  g(r2>®2’^)  ®92  ~  **(r2, 02.62)  ®e2-  (2-50) 

The  alignment  vector  a  in  Equation  2-49  depends  on  seven  parameters:  dr^,  dOj,  dEj, 
d02  +  A<j>,  d£2.  At],  and  Ay.  Note  that  the  effect  of  the  yaw  alignment  parameter  A<1)  cannot  be 
separated  from  the  effect  of  the  azimuth  offset  d02  in  the  2-D  sensor.  Since  the  sensors  are  close 
to  each  other  (much  closer  than  the  distances  to  targets  of  interest)  and  the  alignment  errors  are 
assumed  to  be  small,  it  may  be  difficult  to  separate  the  effects  of  the  remaining  seven  parameters 
in  the  data.  That  is,  observability  problems  may  be  encountered  if  an  attempt  is  made  to  estimate 
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all  seven  parameters.  This  occurs  because  some  of  the  vectors  multiplying  the  parameters  in 
Equation  2-49  are  nearly  parallel  when  the  sensors  are  close  to  each  other.  In  particular,  if  the 
sensors  are  close  to  each  other  and  the  alignment  errors  are  small,  f(62,e})  will  be  nearly  parallel 
to  f(02,e2).  g(ri,0i,e2)  will  be  nearly  parallel  to  g(r2,02,e2)*  h(ri,0i,ei)  will  be  nearly  parallel 
to  h(r2,02>C2)*  In  addition,  f(0j,E2)  and  f(d2,£2)  have  the  same  length  (because  both  are  unit 
vectors),  g(rj,0i,ej)  and  g(r2,02.e2)  nearly  the  same  length,  and  h(rj,0j,E2)  and  h(r2,02,e2) 
have  nearly  the  same  length.  Thus,  the  alignment  vector  a  in  Equation  2-49  and  the  random 
error  vector  e  in  Equation  2-50  may  be  simplified  by  replacing  f(0i,Ej)  with  f(02,e2),  g(ri,0j,E2) 


with  g(r2,02,e2),  and  h(r2,02,e2)  with  h(r2,02,e2).  This  gives 

a  =  C2AT]  +  C2A\|r  +  C3A0  +  C4A£,  (2-51) 

and 

e  =  C3e0  +  C4e£,  (2-52) 

where 

A0  =  d02  -  d02  -  A<|),  Ae  =  d£2  -  de2,  Cq  =  6^2  -  602*  =  ©£2  -  (2-53) 

and 

C3  =  g(r2.02’^)  =  [y2  -^2  0]^’  (2-54) 

C4  s  h(r2,02.£2)  =  [-Z2<y<n®2  -^2  cos  62  T2CosB2]^.  (2-55) 


The  alignment  vector  a  in  Equation  2-51  is  expressed  in  terms  of  g(r2, 02*62)  and  h(r2,02,e2)  firom 
the  2-D  sensor,  rather  than  g(r2,02,e2)  and  h(r2,02,e2)  from  the  3-D  sensor,  because  the  2-D 
sensor’s  measurements  are  usually  more  accurate  than  the  3-D  sensor’s  measurements  (e.g.,  the 
2-D  sensor  may  be  an  optical  sensor  that  provides  very  accurate  angular  information).  Of 
course,  the  range  information  assigned  to  the  2-D  sensor  depends  on  the  3-D  sensor’s 
measurements. 

In  Equation  2-51,  there  are  four  alignment  parameters  that  have  to  be  determined:  the  pitch 
parameter  Ati,  the  roll  parameter  Ay,  the  azimuth  parameter  A0,  and  the  elevation  parameter  Ae. 
Note  that  it  is  not  necessary  to  know  the  individual  alignment  parameters  in  each  sensor  to  align 
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the  target’s  position  vector  from  each  sensor.  Rather,  it  is  only  necessary  to  determine  the 
differences  in  the  respective  alignment  parameters.  The  alignment  vector  a  in  Equation  2-51  can 
be  expressed  in  matrix  notation  as 

a  =  Cb.  (2-56) 

where  the  4  x  1  alignment  parameter  vec*:  .r,  b,  and  the  3  x  4  matrix,  C,  are  given  by 

b  =  [  Ati  Ay  A0  Ae  ,  C  =  [  Cj  C2  C3  C4  ] .  (2-57) 

The  elements  of  the  matrix  C  are  known  and  are  related  to  the  sensor’s  measurements. 
However,  the  alignment  parameter  vector  b  is  not  known  and  it  must  be  determined.  If  the  3-D 
sensor  is  chosen  as  the  master  sensor.  Equation  2-41  is  the  appropriate  alignment  equation  and  it 
can  be  expressed  as 

fi  =  r2  +  t  +  C  b  +  e.  (2-58) 

If  the  2-D  sensor  is  chosen  as  the  master  sensor,  then  Equation  2-43  is  the  appropriate  alignment 
equation  and  it  can  be  expressed  as 

r2  =  Tj  -  t  -  C  b  -  e.  (2-59) 

Equations  2-58  and  2-59  account  for  the  effects  of  the  attitude  and  offset  errors  in  both  sensors. 
Equation  2-58  is  the  transformation  that  aligns  the  2-D  sensor  relative  to  the  3-D  sensor,  and 
Equation  2-59  aligns  the  3-D  sensor  relative  to  the  2-D  sensor. 
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3.0  ALGORITHM  DEVELOPMENT 


To  align  the  position  vectors  using  Equation  2-58  or  Equation  2-59,  the  alignment 
parameter  vector  b  must  be  known.  Assuming  that  both  sensors  are  tracking  a  common  target 
(so  that  and  r2  can  be  calculated),  it  would  seem  that  Equation  2-58  or  Equation  2-59  could  be 
used  to  directly  estimate  b.  That  is,  the  equation 

fj  -  rj  -  t  =  Cb  +  e,  (3-1) 


(where  r  j  -  r2  - 1  is  known)  would  serve  as  the  measurement  equation,  and  it  would  be  used  to 
obtain  the  estimate  of  b.  However,  there  is  a  problem  with  this  approach,  which  can  be  seen  as 
follows.  The  random  error  vector  e  in  Equation  2-52  can  be  expressed  as 


e  =  Ae',  (3-2) 

where  A  =  [  C3  C4  ]  is  a  3  x  2  matrix,  and  e'  =  [  eg  e^  is  a  2  x  1  random  measurement 
error  vector.  The  covariance  of  e'  is  given  by  the  2  x  2  matrix  W,  where 

W  =  diagCoJ  .  oj),  (3-3) 


and 


Oo  =  G, 


ei 


+  o, 


92 


<^e  = 


^el 


4 


(3-4) 


Here,  Oqj  and  Ogj  are  the  standard  deviations  in  the  3-D  sensor’s  azimuth  and  elevation 
measurements,  and  Gq2  and  0^2  ^  the  standard  deviations  in  the  2-D  sensor’s  azimuth  and 
elevation  measurements.  The  covariance  of  e  is  the  3  x  3  matrix  given  by 

Cov(e)  =  AWAT.  (3.5) 
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Equation  3-5  is  the  source  of  the  difficulty  because  the  3  x  3  matrix  Cov  (e)  cannot  have  a 
rank  that  is  larger  than  the  rank  of  W  (which  has  rank  two).  Therefore,  Cov  (e)  is  not  an 
invertible  matrix.  This  problem  occurs  because  the  3  x  2  matrix  A  cannot  have  full  row  rank.  It 
can  be  shown  that 

{sin  62)  X  (Row  1  of  A)  +  {cos  62)  x  (Row  2  of  A)  +  {tan  ^  (Row  3  of  A)  =  0,  (3-6) 

and  the  same  relationship  holds  for  the  rows  of  C.  That  is,  the  rows  of  A  are  linearly  dependent, 
and  the  rows  of  C  have  the  same  linear  dependence.  This  means  that  Equation  3-1  contains  a 
redundant  relationship.  Thus,  one  of  the  relationships  in  Equation  3-1  will  have  to  be  eliminated. 
The  vector  equation  in  Equation  3-1  can  be  expressed  as  the  following  three  scalar  equations 

=  ^2  ~  ~  {z^sinQ^^iss.  +  y2e0  -  {ziSinQ-^t^,  (3-7) 

yi  =  y2  +  V  “  ~  ^2^0  “  (z2cns02)Ae  -  Xjee  -  (3-8) 

zj  =  zj  +  tjj  +  X2ATI  +  y2A\)r  +  {r2  cos  £2)  M  +  (r2  cos  £2)6^.  (3-9) 

Equations  3-7  and  3-8  can  be  combined  into  a  single  relationship  using  tanOj  =  Xj/yj,  or 

Xj  cos  01  =  yi  sin  0i  (which  holds  even  when  0i  =  90°,  270°).  Using  this  gives 

mi  =  (sin  £2  cos  0i)  Ati  -  (sin  £2  sin  0i)  Ay  -  (cos£2Cos  (02'-0i))  A0 

+  (sin£2Sin(02-0i))  Ae  -  (cos  £2  cos  (02 -0i))  £9 

+  (sin  £2  sin  (02  -  0i))  e^,  (3-10) 

where 

L  cos  01  -  Iv  sin  0] 

mi  =  cos  £2  sin  (02 -0i)  +  - ^ - .  (3-11) 

Equation  3-9  can  be  expressed  as 

m2  =  (cos  £2  sin  02)  At)  +  (cos  £2  cos  02)  Ay  +  (cos£2)A£  +  (cose2)e£,  (3-12) 
where 
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rj  sin  €j 


-  SinEq  —  — . 


(3-13) 


Equations  3-10  and  3-12  can  be  expressed  in  matrix  notation  as 

m  =  H  b  +  ,  (3-14) 

where  m  =  [  m2  ]^,  H  =  [  hj  h2  h3  h4  ]  is  a  2  x  4  matrix,  =  D  e'  is  a  random 
error  vector,  D  =  [  h3  h4  ]  is  a  2  x  2  matrix,  and 


h|  =  [ime2CO5  0j  cos  £2  62]^.  (3-15) 

h2  =  [-sme2sm0i  cos  £2  cos  02  ]^,  (3-16) 

h3  =  [  -  cos  £2  cos  (02  -  0])  op,  (3-17) 

h4  =  [  sin  £2  sin  (02  -  0^)  cos  62]'^.  (3-18) 


Since  Equation  3-14  represents  two  equations  with  four  unknowns,  it  will  be  necessary  to 
observe  at  least  two  targets  at  the  same  time,  or  a  single  target  (which  is  not  stationary)  that  is 
being  tracked  over  time,  in  order  to  obtain  a  solution  for  these  four  unknowns.  If  two  or  more 
targets  are  being  observed,  there  will  be  an  H  matrix,  a  D  matrix,  and  an  vector  for  each 
target.  In  this  case,  all  of  these  matrices  can  be  augmented  into  a  single  large  system  of  the  form 
presented  in  Equation  3-14.  That  is. 


z  =  Fb  +  v. 

(3-19) 

where 

2  =  [in[  ••• 

"•Sf. 

(3-20) 

F  =  [n]  ... 

(3-21) 

=  [«ml  ••• 

(3-22) 

and  N  is  the  total  number  of  targets.  Equation  3-19  represents  2N  equations  with  four  unknowns 
and  it  can  be  used  to  estimate  b.  Once  b  is  determined,  then  Equation  2-58  or  Equation  2-59  can 
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be  used  to  align  the  position  vectors. 

Kalman  filtering  techniques  will  be  applied  to  Equation  3-19  to  obtain  the  estimate  of  b. 
The  vector  b  will  be  assumed  to  be  a  constant  that  is  driven  by  zero-mean  white  noise;  that  is, 
the  dynamics  for  b  are  given  by 

by  =  by_i  +  Wy_i,  (3-23) 

where  Wy_|  is  the  zero-mean  white  noise  term  with  covariance  matrix  Qy,  and  the  subscript  j 
refers  to  the  /*  update  on  the  targets.  The  measurement  of  b  at  the  update  is  given  by 
Equation  3-19, 

Zj  =  Fyby  +  Vy.  (3-24) 

The  estimate  of  b  for  the/*  update,  denoted  by  by ,  is  generated  by  the  difference  equation 

by  =  by..l  +  Ky(Zy  -  Fy  b^J  ),  (3-25) 

where  the  Kalman  gain  Ky  is  given  by 

=  *Vl  f  PylM  *  Sy  (3-26) 

and  Sy  is  the  covariance  matrix  for  Vy.  The  one-step  predicted  covariance  Py)y_]  is  given  by 

=■  +  Q;-, ,  (3-27) 

and  the  covariance  matrix  Pyy  is  generated  by 

=  [I  -  KyF^]P^^,,  (3-28) 

where  I  is  the  identity  matrix.  The  Kalman  filter  algorithm  requires  an  initial  estimate  of  b  and 
an  initial  covariance  matrix  **0I0*  Since  there  may  not  be  an  initial  estimate  of  b,  the  simplest 

A 

procedure  is  to  let  bQ  =  0.  Theoretically,  the  initial  covariance  matrix  Pq|q  is  infinite  because 
there  is  no  a  priori  information  about  b.  However,  in  practice,  this  problem  can  be  dealt  v/ith  by 
choosing  a  sufficiently  large  **0K)* 
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4.0  SIMULATION  RESULTS 


This  algorithm  was  tested  by  generating  a  single  track  and  including  alignment  and  random 
errors  in  the  track  data.  The  3-D  sensor  is  located  at  the  origin,  and  the  2-D  sensor  is  located  at 
t^  =  ty  =  25  m  and  t^  =  10  m.  The  standard  deviations  in  the  sensor’s  measurements  are  given  by 


Oji  =  10  m,  O01  =  Ogi  =  0.1°,  002  =  0^2  =  0.02®.  (4-1) 

The  following  alignment  errors  were  included  in  the  3-D  sensor’s  data 

dtj  =  50  m,  dOj  =  1®,  de^  =  0.5®,  <{>,  =  =  yj  =  1°,  (4-2) 

and  the  alignment  errors  included  in  the  2-D  sensor’s  data  are  given  by 

d02  —  ~~  1®,  d£2  —  ~  0.5°,  <j)2  —  1)2  ~  V2  “  ~  (^'3) 

Using  these  values  in  Equations  2-14  and  2-53  gives  the  following  values  for  the  four  alignment 
parameters. 

At)  =  2®,  A\|r  =  -2®,  A0  =  4®,  Ae  =  1®.  (4-4) 


The  3-D  sensor’s  measurements  are  used  to  obtain  the  target’s  position  vector  in  the  3-D 
sensor’s  frame.  The  range  measured  by  the  3-D  sensor  is  used  in  Equatic  i  2-31  to  calculate  the 
target’s  range  in  the  2-D  sensor’s  measurement  frame,  and  the  target’s  position  vector  in  the  2-D 
sensor’s  frame  can  be  obtained.  The  data  are  assumed  to  be  time  coincident,  and  both  sensors 
are  reporting  data  at  regular  intervals  of  0.5  sec.  The  Kalman  filter  described  in  the  previous 
section  was  implemented  to  obtain  the  estimates  of  b.  The  initial  estimate  of  b  was  taken  to  be 
zero,  and  the  initial  covariance  matrix  used  was  given  by  Pqiq  =  I,  where  Oq  =  0.17  and  I  is 
the  identity  matrix.  Also,  the  covariance  matrix  Qj  for  the  iiiput  noise  was  assumed  to  be 
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constant  with  Qj  =  I,  where  a  =  0.001  x  T  and  T  is  the  update  interval  in  seconds. 

The  track  coordinates  of  the  target  (which  is  a  closing  target)  before  and  after  alignment  are 
presented  in  Figure  4-1.  The  solid  line  is  the  target’s  track  as  measured  by  the  3-D  sensor,  and 
the  dotted  line  is  the  target’s  track  as  measured  by  the  2-D  sensor,  but  expressed  in  the  3-D 
sensor’s  frame.  The  separation  between  the  tracks  before  alignment  is  due  to  the  alignment 
errors  in  the  sensors.  The  estimates  of  the  alignment  parameters  from  the  Kalman  filter  were 
used  in  Equation  2-58  to  align  the  2-D  sensor’s  track  to  the  3-D  sensor’s  track.  To  the  scale  of 
the  graphs  in  Figure  4-1,  the  tracks  after  alignment  are  indistinguishable. 

The  measured  azimuth  and  elevation  angles  before  and  after  alignment  are  presented  in 
Figure  4-2,  where  all  of  the  data  are  expressed  in  the  3-D  sensor’s  measurement  frame.  The 
solid  lines  represent  the  3-D  sensor’s  measurements,  and  the  dotted  line  the  2-D  sensor’s 
measurements.  The  measurements  are  indistinguishable  after  alignment. 

The  estimates  of  the  four  alignment  parameters  from  the  Kalman  filter  arc  presented  in 
Figure  4-3.  The  dotted  lines  in  Figure  4-3  represent  the  true  values  of  the  alignment  parameters, 
which  are  also  given  in  Equation  4-4.  It  takes  approximately  100  updates  (50  sec)  before  the 
estimates  converge  to  values  near  their  true  values.  However,  the  estimate  of  the  azimuth 
parameter  converges  much  more  quickly  than  the  others.  The  distance  between  the  target’s  track 
as  reported  by  the  3-D  sensor  and  the  2-D  sensor  is  presented  in  Figure  4-4.  The  distance  before 
alignment  is  quite  large  (an  average  of  969  m  for  the  200  updates).  After  alignment,  the  average 
distance  over  the  200  updates  is  42  m,  or  a  factor  of  23  times  smaller  than  the  before  alignment 
distance.  Thus,  the  alignment  algorithm  performs  well  in  estimating  the  alignment  errors  and 
aligning  the  tracks. 
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Figure  4-1.  Track  Coordinates  Before  and  After  A*pplying 
the  Alignment  Algorithm  to  the  Track  Data 


Figure  4-2.  Azimuths  and  Elevations  of  the  Track  Before  and 
After  Applying  the  Alignment  Algorithm  to  the  Track  Data 
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Figure  4-3.  Estimates  of  the  Alignment  Parameters 


Figure  4-4.  Distance  Between  the  Tracks  Before  and  After 
Applying  the  Alignment  Algorithm  to  the  Track  Data 
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5.0  SUMMARY 


The  problem  of  aligning  two  sensors  using  targets  of  opportunity  was  examined  in  this 
report,  where  one  of  the  sensors  is  a  3-D  sensor  that  measures  range,  azimuth,  and  elevation  and 
the  other  one  is  a  2-D  sensor  that  measures  azimuth  and  elevation.  Both  a  mathematical  model 
and  an  alignment  algorithm  were  developed  for  this  problem,  where  attitude  and  offset  errors  in 
both  sensors  are  included  in  the  formulation.  Because  of  the  method  used  to  formulate  the 
problem,  it  is  not  possible  to  determine  the  individual  alignment  errors  at  each  sensor.  However, 
it  is  possible  to  determine  the  differences  in  the  respective  alignment  errors  of  the  two  sensors; 
that  is,  one  sensor  appears  to  be  perfectly  aligned  and  it  is  called  the  master  sensor.  The 
algorithm  developed  in  this  report  aligns  the  other  sensor  relative  to  the  master  sensor.  The 
problem  is  formulated  to  allow  either  sensor  to  serve  as  the  master  sensor.  Of  course,  both 
sensors  cannot  be  the  master  sensor  at  the  same  time.  The  alignment  algorithm  is  applicable  to 
those  situations  where  the  distance  between  the  sensors  is  small,  the  magnitude  of  the  alignment 
errors  is  small,  and  the  alignment  errors  do  not  change  with  time  (stationary). 

For  illustrative  purposes,  the  alignment  algorithm  was  applied  to  simulated  data  from  two 
sensors  that  were  tracking  a  target  undergoing  a  simple  maneuver.  Each  of  the  sensors  had 
realistic  values  for  their  measurement  errors.  The  filter  converged  within  50  sec  to  values  of  the 
azimuth,  elevation,  pitch,  and  roll  alignment  errors  that  are  very  close  to  their  actual  values. 
Utilizing  these  values,  it  was  possible  to  obtain  a  dramatic  23-fold  reduction  in  the  relative  error 
between  the  tracks  generated  by  the  sensors.  For  further  verification  of  this  algorithm,  it  should 
first  be  applied  to  a  large  number  of  simulated  tracks  following  different  trajectories  and  then  to 
simultaneous  data  from  real  target  tracks. 
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